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1.  Introduction 

The  safety  of  manned  or  unmanned  space  vehicles  returning  to  earth  is  of  paramount  importance. 
One  way  to  improve  their  safety  is  by  creating  more  capable,  reliable  and  efficient  guidance, 
navigation,  and  control  methods.  Onboard,  real-time  optimal  trajectory  generation,  planning, 
adaptation,  reconfiguration,  and  retargeting  are  the  methods  currently  being  pursued  to  achieve 
the  autonomous  operations  needed  to  facilitate  the  accomplishment  of  these  objectives. 

Previous  work  by  Shaffer  [l]-[2]  has  integrated  trajectory  reshaping  and  retargeting  with  the 
reconfigurable  control  work  of  Oppenheimer  et  al.  [3]-[5],  to  demonstrate  relatively  fast 
computations  of  optimal  trajectories  under  trim  deficient  path-constraints.  This  work  used 
interpolated  aerodynamic  data  that  incorporated  wing,  body  and  trim  effects  from  a  given  vehicle 
flight  condition  and  an  optimized  effector  displacement  vector  [2],  This  essentially  decoupled 
the  outer  loop  from  the  inner  loop.  Despite  efforts  involving  on-line  approaches  [6]-[l  1],  off¬ 
line  reference  trajectories  are  still  used  for  tracking  applications.  Since  the  early  days  of  space 
shuttle  entry  guidance,  designers  have  been  employing  various  reference  trajectory  tracking 
schemes  [12],  Various  research  has  addressed  the  reentry  problem  by  using  an  optimal  trajectory 
generator  to  solve  for  a  reference  input  trajectory  off-line,  then  use  other  inner-loop  control 
means  to  track  the  desired  trajectory  [13]-[15].  In  some  cases,  off-line  reference  trajectories  are 
combined  with  on-line  trajectory  generators  such  as  the  “Optimum-Path-To-Go”  methodology 
developed  by  Schierman  et  al.,  as  previously  cited. 

In  a  similar  fashion,  this  paper  combines  some  of  the  approaches  mentioned  to  demonstrate  that  a 
previously  developed  inner-loop  control  design  based  on  dynamic  inversion  can  successfully 
track  variable  body-axis  roll,  pitch,  and  yaw  commands  generated  from  an  off-line,  optimal 
reference  trajectory.  For  this  work,  a  full,  6-degree-of- freedom  (DOF)  model  of  a  reusable 
launch  vehicle  (RLV)  was  employed  for  the  inner-loop  tracking  simulation  whereas  the  reference 
trajectory  was  generated  using  a  psuedo-4-DOF  model.  The  reference  trajectory  uses  a  rapid, 
direct  method  that  has  the  potential  for  on-line  applications  such  as  the  optimal  nonlinear 
feedback  approach  demonstrated  in  [16]. 

To  solve  the  optimal  control  problem,  a  spectral  algorithm  [17]-[19]  known  as  the  Legendre 
Pseudospectral  Method  is  employed  by  use  of  a  MATLAB-based  software  package  called  DIDO 
[20].  This  direct  method  discretizes  the  problem  and  approximates  the  states,  co-states  and 
control  variables  by  use  of  Lagrange  interpolating  polynomials  where  the  unknown  coefficient 
values  coincide  with  the  Legendre-Gauss-Lobatto  (LGL)  node  points.  After  this  approximation 
step,  a  nonlinear  programming  program  (NLP)  solver  (SNOPT)  solves  a  sequence  of  finite- 
dimensional  optimization  problems  that  capture  the  nonlinearites  of  the  system  in  the  form  of  an 
optimal  control  problem.  For  an  extensive  description  of  this  method  and  its  use  for  reentry 
applications,  see  references  [l]-[2],  [16],  and  [17]-[22], 

The  purpose  of  this  work  is  based  on  various  components  leading  to  the  development  of  high- 
fidelity  footprint  generation.  The  following  list  identifies  the  specific  objectives  for  this  study. 

1.  To  see  how  well  the  inner- loop  controller  tracks  the  DIDO  (optimal)  command  histories 
and  identify  any  problems 
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2.  To  verify  what  the  body-frame  angular  rates  (P,Q,R)  should  be  (steady-state  trim  values?) 
since  previously  assumed  constant  in  other  studies 

3.  To  generate  initial  guesses  for  6-DOF  DIDO  model  (Note:  Not  required  unless  real-time 
implementation  is  desired) 

4.  To  eventually  compare  6-DOF  simulation  control  deflection  histories  to  optimal 
deflections  computed  by  a  6-DOF  DIDO  model  in  order  to  make  generalizations  about 
inner/outer  loop  interactions/conflicts  and  determine  better  cost  functions  for  the  control 
allocator 

5.  To  eventually  compare  DIDO’s  6-DOF  “integrated”  G&C  states  to  PQR-Tracking 
“separated”  G&C  states  to  confirm  conjecture  regarding  “integrated”  G&C  feasibility 

3.  Guidance  and  Control  Design  Architecture 

The  overall  guidance  and  control  design  architecture  for  this  work  is  presented  in  Fig.  1  below. 
As  seen,  the  architecture  consists  of  a  two-loop  structure:  (1)  an  outer  loop  that  compares  the 
actual  angle-of-attack  and  the  bank  angle  measurements  with  those  provided  from  the  optimal 
reference  trajectory  outputs  and  (2)  an  inner-loop  that  is  designed  to  track  the  optimal  body-rates 
(p,q,r)  generated  from  the  guidance  command  generator. 


state  Feedback 


a,  (p  Feedback 


Fig.  1:  Overview  of  G&C  Design  Architecture 


4.  Outer-Loop  Guidance  Command  Generation 
4.1.  Off-Line,  Optimal  Trajectory  Generation 

First,  an  off-line  reference  trajectory  is  generated  by  posing  the  reentry  problem  into  a  standard 
nonlinear  programming  fashion  and  solving  for  the  optimal  controls  using  a  direct  Legendre 
psuedospectral  method.  For  this  paper,  a  reduced-order  model  is  adequate  to  demonstrate  the 
feasibility  of  the  approach.  Thus,  the  full  6-DOF  equations  of  motion  are  simplified  and 
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decoupled.  The  model  used  here  assumes  a  point-mass-model  over  a  flat,  non-rotating  earth 
such  that  the  positional  and  translational  equations  of  motion  in  a  Cartesian  “local  horizontal” 
coordinate  system  become 


x  =  V  cos  J3  cosy 
y  =  V  sin/?cosf 
z  =  V  sin  y 

v  D 

V  = - g  sin  y 

m 

L  gcosy 

y  = - 

mV  V 

L  sin  <b 

y/  = - — 

m  V  cos  y 


(1) 


where  x  (down-range),  y  (cross-range),  and  z  (altitude)  are  the  vehicle’s  position  with  respect  to 
the  fixed-earth  reference  frame,  V  is  the  velocity  magnitude  (i.e.  total  equivalent  airspeed),  y  is 
the  flight-path-angle  (FPA),  y/  is  the  azimuth  angle,  a  is  the  angle-of-attack  (AoA),  (f>  is  the 

angle-of-bank  (AoB),  p  is  the  sideslip  angle,  and  m  is  the  vehicle’s  approximate  mass  during 
reentry  modeled  as  2455  slug  (-79,000  lbs). 


The  lift  and  drag  forces  are  represented  as  L  and  D,  respectively,  and  are  given  by 

L  =  \pV'-CLSr« 

D  =  ^PV2CdS 

where  Sref  =  1600  ft  is  the  aerodynamic  reference  area.  The  aerodynamic  coefficients  are 
assumed  to  be  functions  of  state  variables  only: 

CL,CD=f(a,M)  (4> 

and  the  Mach  number  and  atmospheric  density  are  functions  of  altitude: 

M  =M  (z)  (5) 

p  =  p(z)  (6) 

The  lift  and  drag  coefficients  are  computed  using  table  lookup  data  that  incorporates  wing,  body, 
and  trim  effects.  Likewise,  the  Mach  and  density  are  computed  using  table  lookup  data  based  on 
a  standard  1976  atmospheric  model.  See  Ref.  [2]  for  more  details  on  the  use  of  table  lookup  data 
for  a  similar  model. 


(2) 

(3) 


The  controls  to  be  optimized  for  this  problem  are  essentially  the  standard  AoA  and  AoB 
modulation,  but  to  help  compensate  for  command  delays  (i.e.  lags)  and  to  add  more 
realism/fidelity  to  the  problem,  as  explained  in  Ref.  [1]  and  [2],  the  rates  of  these  angles  are  used 
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as  “virtual”  controls.  This  has  the  benefit  of  allowing  rate  limits  on  AoA  and  AoB  which 
prevents  unrealistic  responses.  Therefore,  the  control  vector  is  defined  as 


u  =  [d  <j)]T  eft2 

and  the  state  vector  is 

x  =  [xyzVy\|/a  0]T  e  T?8 

As  with  any  dynamical  optimization  problem,  the  cost  function  (objective  function),  governing 
equations  of  motions,  path  constraints,  boundary  limits  on  initial/final  conditions,  and  any 
constraints  (on  states  and/or  controls)  must  be  defined.  As  such,  the  general  optimal  control 
problem  for  trajectory  generation  is  fully  posed  in  the  following  manner: 

Tr 

minw  T(x(r),M(r),r0,r/)  =  £'(x(r0),x(t/),r0,r/)  +  |F(x(r),w(r),r)c/r 

To 

subject  to  x  =  f(x,u,r )  (9) 

hi  -  h(x.’U,T)  < 

§i  Ze(x(T0),x(Tf),T0,Tf)<$, 

Ml  T )<uu 


The  goal  is  to  find  a  state-control  function  pair,  jx(-),  w(-)} ,  or  sometimes  time,  z  ,  that 
minimizes  the  performance  index  represented  by  the  Bolza  form,  J  (■  ) ,  consisting  of  either  a 
Mayer  term,  E (•) ,  a  Lagrange  term,  F  (•) ,  or  both  as  stated  above. 

Summarizing  the  previous  reentry  equations,  the  specific  optimal  control  formulation  for  this 
RLV  problem  is  stated  as  follows:  Given  an  initial  position  vector  ([x0,  y0,  z0]) ,  velocity 

magnitude  (V0),  FPA  (y0),  heading  angle  ( i//() ) ,  AoA  (<z0) ,  and  AoB  (<j){]) ,  find  the  control 

history  (a,  that  maximizes  the  horizontal  downrange  (x; )  or  cross-range  (yy  |  under 
various  constraints. 
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In  the  context  of  equation  of  (9)  above  and  for  the  analysis  presented  in  this  work,  the  cost 
functions  are  simply: 


Min  {  /[•]  =  -  xf}  -  or  -  Min  {  /[•]  =  -  yf } 


(10) 


subject  to  the  dynamic  constraints  given  by  those  equations  in  (1),  the  initial  and  final  event 
conditions  specified  as: 


ft 

h0,x0,y0,z0,F0,y0,^0,a0,^0)  =  (0, 0,0, 125000ft,  5714— 1.3  deg,  0,0  deg,  0)  (11) 

S 


(hf,Vf)  =  (500  ft,  335-) 

S 

_  _  ft  .  „  ft 

-25-<z,  <8.33- 


(12) 

(13) 


and  the  state  (14),  path  (15),  and  control  (16)  inequality  constraints,  respectively,  specified  as 


0 

X 

00 

—GO 

y 

00 

0 

z 

00 

0 

-90  deg 

< 

V 

r 

< 

00 

90  deg 

-90 deg 

V 

90  deg 

-lOdeg 

a 

50  deg 

-90  deg 

_<P_ 

90  deg 

-2.5g's 

0 

0 

< 

A- 

<7 

_Q_ 

< 

2.5g's 

600^ 

ft2 

60  BTU 
ft-s 

<40 


deg 


(14) 


(15) 


(16) 


4.2.  On-Line  Optimal  Trajectory  Generation 

Although  this  work  computes  the  optimal  reference  trajectory  off-line  and  then  extracts  the 
appropriate  signals  to  use  in  the  guidance  command  generation  algorithm,  preliminary  studies 
conducted  concurrently  with  this  work  have  indicated  that  the  same  model  using  approximated 
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aerodynamic  data  can  solve  the  problem  approximately  85  %  faster  than  using  the  table  look-up 
data.  For  example,  recent  work  used  a  second-order  polynomial  approximation  for  lift  and  drag 
coefficients  and  a  standard  two-parameter  exponential  atmospheric  model  that  resulted  in  the 
successful  implementation  of  a  nonlinear  sampled-data  feedback  method  with  an  on-line, 
trajectory  re-optimization  scheme  that  could  generate  optimal  trajectories  99.75  %  faster  than  the 
same  model  using  the  table  look-up  data  [16].  Further  work  is  required  to  improve  the  accuracy 
of  the  approximations,  but  initial  results  look  promising  for  on-line  reentry  applications. 


4.3.  P,Q,R  Command  Generation  via  “Backstepping  Architecture”  (PI  &  DI) 

From  the  optimal  trajectory,  the  a  and  ((>  commands  are  converted  into  the  body-axis  angular 
velocities  (P,  Q,  R)  to  provide  the  desired  inner-loop  commands.  The  generation  of  these 
commands  is  based  on  what  Schierman  defines  as  a  “backstepping”  approach  whereby  the 
“pseudo-commands”  at  each  loop-closure  using  proportional-integral  (PI)  control  and  dynamic 
inversion  (DI)  drives  the  next  inner-most  loop  [23].  Common  loop  closures  may  consist  of  an 
outer-most  altitude  loop,  a  FPA  loop,  and  an  enclosed  inner-most  AoA  loop.  For  this  experiment, 
the  3 -DoF  DIDO  trajectory  provides  the  a  and  §  commands  that  are  then  used  to  generate  the 
body-rate  commands  (P,  Q,  R).  For  example,  assuming  only  longitudinal  guidance,  the 
appropriate  pitch  rate  command  is  generated  based  on  the  following  calculations. 


Assuming  only  longitudinal  motion  and  ignoring  later-directional  influences  (for  now),  the  wind- 
axis  relation  a  =  6 -y  and  the  simplified  pitch  rate  0  =  0  provide  the  governing  equation  of 
motion  such  that 

a  =  -y  +  Q  (17) 

Also,  the  governing  equation  of  motion  for  the  FPA  is 


L  gcos(d) 
mV  V 


(18) 


Substituting  eqn.  (17)  into  eqn.  (18),  the  resulting  Q-command  is  derived  as 


Qcmd 


■  a 


des 


L 

H - 

mV 


gcos(y) 

V 


(19) 


To  improve  a  tracking,  the  desired  a  dynamics  are  generated  using  a  proportional  feedback 
controller 


« des=Ka(acmd-a ) 

where  acmd  is  the  optimal  a  command  from  the  3-DoF  DIDO  trajectory. 


(20) 
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Figure  2  shows  a  block  diagram  that  represents  the  computation  of  the  optimal  guidance 
commands. 


Fig.  2:  P  and  Q  Command  Generation 


Note  that  for  the  pitch  command  generation  (Qcmd)  in  Fig.  2,  an  extra  lateral  term  is  added  to 
account  for  lateral  effects  as  explained  in  the  results  section.  Also,  not  shown  in  Fig.  2  ,  is  the 
generation  of  the  yaw  command  (Rcmd)  that  is  computed  according  to  Ref.  [27  ]  assuming 
coordinated  turns  and  is  given  by 


Rcmd=Pcmd^a  + 


gsin^ 


u 


(21) 


5.  Reconfigurable  Inner-Loop  Control 

This  work  implemented  a  6-DOF  simulation  containing  a  reconfigurable  inner-loop  control 
algorithm  that  consists  of  dynamic  inversion,  control  allocation,  and  model  following  prefilters 
with  integrator  anti-windup  and  reference  model  bandwidth  attenuation 

5.1.  Dynamic  Inversion  and  Control  Allocation 

The  inner-loop  control  system  uses  dynamic  inversion  in  order  to  track  the  desired  body- frame 
angular  velocities  (pdes ,  qdes ,  rdes ) .  The  rotational  dynamics  for  this  type  of  vehicle  can  be 
written  as: 


(22) 


Ico  =  GB  —  co  x  Ico 


where  I  is  the  moment-of-inertia  tensor,  co  =  [p,q,r]T ,  and  GB  is  a  vector  consisting  of  the  total 

moments  acting  on  the  vehicle  with  contributions  from  the  wing-body-propulsion  system  (BAE) 
and  the  control  effectors  (£)  such  that 

r  t  n  r  r  n 

(23) 


~  L~ 

~  L~ 

Gb  =  Gbae  {°},P)  +  Gs  (P,  3)  = 

M 

+ 

M 

N 

BAE 

N 

where  L,M,N  are  the  rolling,  pitching,  and  yawing  moments,  respectively,  the  vector  P  denotes 
a  measurable  or  estimable  quantitiy  that  can  influence  body  rates  and  can  contain  variables  such 
as  AoA,  sideslip,  Mach  number,  and  mass  properties,  and  8  is  a  vector  of  control  surface 

deflections  given  by  8  =  [t), , 82 8n ]r .  To  design  the  dynamic  inversion  control  law,  the 

equations  above  are  put  into  a  more  standard  form  by  defining  / (co,  P )  =  GBAE  (co,  P)-ooxIco 
such  that 


Ic6  =  f(co,P)  +  G(P,8 ) 


(24) 


The  objective  is  to  find  a  control  law  that  provides  direct  control  over  co  such  that  co  =  codes ; 
therefore,  the  dynamic  inversion  control  law  must  satisfy 

(25) 

I6odes-f(co,P)  =  G(P,8) 

But,  since  this  problem  has  more  control  effectors  than  control  variables,  a  control  allocation 
algorithm  is  required  for  a  unique  solution.  A  linear  programming  based  control  allocator,  which 
obeys  rate  and  position  limits,  will  be  used  in  this  work.  In  order  to  implement  this  type  of 
allocator,  the  control  dependent  portion  of  Eq.  (25)  must  be  linear  in  the  controls.  Hence,  Eq. 
(25)  is  rewritten  as 

Icodes-f(co,P)  =  G(P,6)  =  G(P)5  (26) 

In  order  to  account  for  nonlinearities  in  the  moment-deflection  relationship,  a  slope-intercept 
term  is  added  to  Eq.  (26)  such  that 


I  (Odes  -  f  («,  P)  =  G(P)5  +  £(P,  5) 
Then,  the  final  inverse  control  law  becomes 

M  -  f(co,  P)  -  I  le(P,  =  I  XGS(P)3 


(27) 


(28) 
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For  more  details  on  this  dynamic  inversion  method  and  the  control  allocation  algorithm  see 
references  [3]-[5]  and  [23]-[25],  A  block  diagram  representation  of  the  dynamic  inversion 
control  law  is  shown  in  Fig.  3. 


Dynamic  Inversion 


Fig.  3:  Dynamic  Inversion  with  Control  Allocation 


5.3.  Model  Following  Prefilters 

To  provide  robustness  to  modeling  errors,  inversion  errors,  and  to  help  shape  the  closed- loop 
response,  prefilters  were  added  to  the  dynamic  inversion  control  system  previously  described. 
Previous  work  involving  the  inner-loop  control  designs  for  the  X-40A  tested  two  different 
prefilter  structures:  implicit  [4]  and  explicit  [23].  For  this  work,  an  implicit  model-following 
scheme  was  selected  based  on  its  simplicity  in  regards  to  having  fewer  gains  that  would 
ultimately  need  tuning.  Also,  it  was  desired  that  the  closed-inner-loop  control  system  from  a>des 
to  co  has  the  characteristics  of  a  first-order  response.  The  implicit  structure  presented  in  Fig.  5 
provides  this  behavior  and  helps  compensate  for  imperfections  in  the  dynamic  inversion  control 
law.  A  closer  look  at  this  structure  with  some  straight-forward  block  diagram  algebra  reveals 
that  a  stable  pole/zero  cancellation  occurs.  The  resulting  transfer  function  displays  the  desired 
closed-inner-loop  response: 
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CO 


(29) 


*6 
.2 

0}des  s  + 

2 

Note  that  Fig.  5  only  displays  a  single  loop;  however,  the  actual  model  implemented  contained  a 
loop  for  each  of  the  body-axis  angular  rates. 


Dynamic  Inversion 


Fig.  4:  Dynamic  Inversion  with  Control  Allocation  and  Prefilters 


5.4.  Integrator  Anti-Windup  and  Reference  Model  Bandwidth  Attenuation 

Axis  saturation  occurs  when  all  control  power  is  used  on  one  or  more  axes.  For  flight  control 
applications,  when  a  control  surface  moves  at  its  rate  limit  or  resides  on  a  position  limit,  then 
control  effector  saturation  occurs.  This  is  a  necessary,  but  not  sufficient,  situation  for  axis 
saturation.  With  axis  saturation,  no  additional  control  power  is  available  when  requested  by  the 
control  system  and  this  should  be  taken  into  account  by  the  control  law.  Analysis  of  the  control 
allocation  inputs  (ddes)  and  outputs  (B8)  can  indicate  axis  saturation.  To  prevent  canceling 
tracking  errors  caused  by  the  axis  saturation,  the  following  integrator  anti-windup  law  is  added  to 
reduce  the  magnitude  of  input  signal  to  the  integrator. 

(30) 

I  AW  ~  ^ A  w  ( B  & cmd  ~  ddes  ) 

where  kaw  is  the  anti-windup  gain,  ddes  is  the  desired  accelerations  from  the  control  effectors,  and 
B5cmd  is  what  the  control  allocator  thinks  is  being  produced  by  the  effectors.  If  no  saturation 
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occurs,  then  BScmd  -  dJri  =  o  and  the  control  law  operates  normally;  otherwise,  at  least  one  axis  is 
saturated  and  the  state  of  the  prefilter  integrator  is  reduced  by  the  anti-windup  signal.  The  anti¬ 
windup  scheme  is  implemented  as  depicted  in  Fig.  5.  For  more  details  on  the  anti- windup 
integrator  and  its  use  see  Ref.  [26]  and  [23], 


Fig.  5:  Implicit  Model  Following  Prefilter  Integrator  Anti-Windup  Compensation 


6.  Results  and  Discussions 

The  primary  performance  concerns  for  this  work  were  tracking  error  and  control  saturation.  Of 
course  the  overall  index  of  performance  is  that  the  cost  functions  for  both  the  outer-loop 
guidance  and  inner-loop  control  agree  to  within  an  acceptable  tolerance.  As  long  as  the  desired 
trajectory  and  cost  were  accomplished,  the  tracking  performance  was  only  graphically  confirmed. 

For  this  paper,  only  the  max  downrange  and  max  cross-range  results  are  presented. 

6.1.  Max  Downrange  (DR)  Case 
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For  the  case  of  maximizing  the  vehicle’s  downrange  distance,  the  3-DOF  optimal  trajectory  is 
generated  off-line  and  a  and  §  histories  are  extracted  for  use  as  the  desired  guidance  commands. 
These  commands  are  shown  in  Fig.  6. 


Fig.  6:  Max  DR  Commands  from  3-DOF  Optimal  Reference  Trajectory 


Initial  comparison  of  the  PQR-guidance  commands  with  the  actual  PQR-states  revealed  that  the 
inner-loop  controller  was  successfully  tracking  the  desired  values;  however,  when  comparing  the 
actual  states  to  those  of  the  reference  trajectory,  there  were  some  unacceptable  errors,  especially 
for  a.  After  carefully  reviewing  the  data,  trial-and-error  gain  tuning  on  the  prefilter  and  anti¬ 
windup  gains,  it  was  determined  that  adding  an  integrator  in  the  command  generation  block 
improves  the  reference  trajectory  tracking  as  seen  from  comparing  Fig.  7  with  Fig.  8. 


Same  I.C.'s  &  No  Integrator  in  Qcmd 


Time  (sec) 
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Fig.  7:  AoA  WITHOUT  Integrator  in  Command  Generation  Logic 


Same  I.C.'s,  Integrator  in  Qcmd,  &  Small  Tunning 


Fig.  8:  AoA  WITH  Integrator  in  Command  Generation  Logic 


With  this  addition  and  use  of  the  gains  in  Table  1,  the  max  DR  results  presented  in  Fig.  9  through 
Fig.  17  were  acceptable  with  an  average  difference  of  only  2  %.  The  cost  for  the  optimal 
reference  trajectory  and  the  simulation  were  1,515,588  ft  and  1,515,852  ft,  respectively,  which 


results  in 
0.017% 


Max  DR 

Max  CR 

Prefilter  BW,  P  (KbP) 

5.0 

4.0 

Prefilter  BW,  Q  (Kb0) 

5.0 

4.0 

Prefilter  BW,  R  (KbR) 

Table  1 :  Gains  used  for  Inner-1 
Integral  DI  (Ki) 

5.0 

Loon  Control  1 

0.5 

4.0 

Svstem 

0.5 

Anti-Windup,  P  (KAw.p) 

0.2 

0.1 

Anti-Windup,  Q  (Kaw.o) 

0.2 

0.1 

Anti-Windup,  R  (KAw.r) 

0.2 

0.1 

only  a 
error. 
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\\ 

Fig.  9:  Max  DR  Linear  Body-Relative  Velocities  (U,V,W) 


^  "m.  m 
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Fig.  11:  Max  DR  Euler  Angles  (Phi,  Theta,  Psi) 


Fig.  12:  Max  DR  Airspeed  (V)  and  Wind-Relative  Angles  (Alpha,  Beta,  Gamma) 
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Time  (sec) 


Fig.  14:  Max  DR  Body  Flap  Control  Surface  Deflections 
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Fig.  15:  Max  DR  Rudder  Control  Surface  Deflections 
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Fig.  17:  Max  DR  Comparison  of  Reference  and  Tracking  Trajectory 


6.2.  Max  Cross-Range  (CR)  Case 

For  the  case  of  maximizing  the  vehicle’s  cross-range  distance,  a  and  (|)  histories  are  extracted 
from  the  off-line  optimal  trajectory  as  was  done  for  the  max  DR  case.  These  commands  are 
shown  in  Fig.  18. 
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Fig.  18:  Max  CR  Commands  from  3-DOF  Optimal  Reference  Trajectory 


For  maneuvers  with  large  bank  angles,  such  as  the  max  CR  case,  there  is  a  loss  of  lift  that  must 
be  countered  in  order  to  maintain  altitude.  Typically,  the  elevator  is  used  to  provide  more  lift.  In 
short,  the  longitudinal  and  lateral  equations  of  motion  are  strongly  coupled  during  maneuvers 
with  large  bank  angles.  For  example,  a  pilot  must  maintain  adequate  backpressure  on  the  yoke 
during  steep  turns  to  prevent  loss  of  altitude.  To  account  for  this  in  the  pitch-command  ( Qcmd ) 

generation,  an  extra  lift  term  [28]  was  added  to  provide  the  appropriate  contribution  from  the 
bank  angle: 


a 

L  =  mg  sec(^)  =>  -^sec(^) 


(31) 


With  this  addition  and  use  of  the  gains  in  Table  1,  the  max  CR  results  presented  in  Fig.  19 
through  Fig.  27  were  acceptable  with  an  average  difference  of  only  2  %.  The  cost  for  the 
reference  trajectory  and  the  simulation  were  664,862  ft  and  671,781ft,  respectively,  which  results 
in  only  a  1 .04  %  error. 


20 


21 


22 


23 


24 


Fig.  27:  Max  CR  Comparison  of  Reference  and  Tracking  Trajectory 


7.  Conclusions 

This  paper  presented  successful  integration  of  a  reconfigurable  inner-loop  control  law  consisting 
of  dynamic  inversion,  control  allocation,  model  reference  prefilters,  and  anti-windup  integrators 
with  an  outer-loop,  optimal  guidance  command  generator.  As  demonstrated,  the  inner-loop 
control  law  was  capable  of  tracking  the  body- frame  angular  rates  that  were  converted  from  the 
wind-relative  a  and  4>  modulation  of  the  off-line  reference  trajectory.  Although  the  optimal 
trajectory  generation  was  done  off-line  for  this  work,  a  similar  model  has  already  been 
demonstrated  to  work  for  on-line  reentry  applications  using  the  same  direct  Legendre 
pseudospectral  method. 

The  major  drawback  of  the  presented  guidance  and  control  architecture  is  that  the  inner-loop 
control  system  alone  is  not  ideal  for  on-board  autonomous  applications.  This  control  law 
requires  various  gains  that  would  make  strictly  autonomous  operations  impractical,  especially  in 
situations  involving  unplanned  maneuvers  and/or  flight  anomolies.  Even  with  the  added 
robustness  provided  by  the  prefilters,  anti-windup  mechanism,  and  the  optimal  control  allocation, 
an  off-line  gain  schedule  would  still  be  required  to  handle  the  numerous  unexpected  operational 
conditions.  With  this  said,  concurrent  and  future  work  involves  the  use  of  on-line  methods  that 
can  account  for  any  unforeseen  circumstances,  including,  but  not  limited  to  uncertain 
aerodynamics,  significant  external  disturbances,  control  failures,  and  vehicle  damage. 

8.  Acknowledgments 

This  work  was  sponsored  by  the  Air  Force  Research  Laboratory  (AFRL/VACA),  WPAFB,  Ohio, 
under  contract  number  FA??????????????,  with  assistance  provided  by  Dr.  David  Doman,  the 


25 


Technical  Area  Leader  for  the  Space  Access  and  Hypersonic  Vehicle  Guidance  and  Control 
Group.  His  guidance  on  this  work  is  greatly  appreciated. 

References 

1.  Shaffer,  P.J.,  Ross,  I.M.,  Oppenheimer,  M.W.,  Doman,  D.B.,  “Optimal  Trajectory 
Reconfiguration  and  Retargeting  for  a  Reusable  Launch  Vehicle,”  Proceedings  of  the 
2005  AIAA  Guidance,  Navigation,  and  Control  Conference,  AIAA  Paper  No.  2005-4168, 
Aug  2005. 

2.  Shaffer,  Patrick  J.,  Optimal  Trajectory  Reconfiguration  and  Retargeting  for  the  X-33 
Reusable  Launch  Vehicle,  Thesis,  Naval  Postgraduate  School,  Monterey,  CA,  2004. 

3.  Oppenheimer,  M.W.,  and  Doman,  D.B.,  “Reconfigurable  Control  Design  for  the  X-40A  with  In- 
Flight  Simulation  Results,”  Proceedings  of  the  2005  AIAA  Guidance,  Navigation,  and 
Control  Conference,  AIAA  Paper  No.  2004-5017,  Aug  2004. 

4.  Oppenheimer,  M.W.,  and  Doman,  D.B.,  “Reconfigurable  Inner  Loop  Control  of  a  Space 
Maneuvering  Vehicle,”  Proceedings  of  the  2003  AIAA  Guidance,  Navigation,  and  Control 
Conference,  AIAA  Paper  No.  2003-5358,  Aug  2003. 

5.  Doman,  D.B.,  and  Oppenheimer,  M.W.,  “Integrated  Adaptive  Guidance  and  Control  for  Space 
Access  Vehicles,  Volume  1 :  Reconfigurable  Control  Law  for  X-40A  Approach  and  Landing,” 
AFRL  IAG&C  Technical  Report,  Wright-Patterson  AFB,  OH,  2004. 

6.  Pesch,  H.J.,  “Off-Line  and  On-Line  Computation  of  Optimal  Trajectories  in  the 
Aerospace  Field,”  Prepared  for  the  12th  Course  in  Applied  Mathematics  in  the  Aerospace 
Field  of  the  International  School  of  Mathematics,  Ettore  Majorana  Centre  for  Scientific 
Culture,  Sicily,  Sept  1991. 

7.  Shen,  Z.  and  Lu,  P.,  “Onboard  Generation  of  Three-Dimensional  Constrained  Entry 
Trajectories,”  Journal  of  Guidance,  Control,  and  Dynamics,  Vol.  26,  No.  1,  pp.l  1 1-121, 
2003. 

8.  Allwine,  D.A.,  Fisher,  J.E.,  Strahler,  J.A.,  Lawrence,  D.A.,  Oppenheimer,  M.W.,  and 
Doman,  D.B.,  “On-Line  Trajectory  Generation  for  Hypersonic  Vehicles,”  Proceedings  of 
the  2005  AIAA  Guidance,  Navigation,  and  Control  Conference,  AIAA  Paper  No.  2005- 
6435,  Aug  2005. 

9.  Verma,  A.,  Oppenheimer,  M.W.,  and  Doman,  D.B.,  “On-Line  Adaptive  Estimation  and 
Trajectory  Reshaping,”  Proceedings  of  the  2005  AIAA  Guidance,  Navigation,  and 
Control  Conference,  AIAA  Paper  No.  2005-6436,  Aug  2005. 

10.  Schierman,  J.D.,  Hull,  J.R.,  and  Ward,  D.G.,  “On-Line  Trajectory  Command  Reshaping 
for  Reusable  Launch  Vehicles,”  Proceedings  of  the  2003  AIAA  Guidance,  Navigation, 
and  Control  Conference,  AIAA  Paper  No.  2003-5439,  Aug  2003. 

11.  Schierman,  J.D.,  Hull,  J.R.,  “In-Flight  Entry  Trajectory  Optimization  for  Reusable 
Launch  Vehicles,”  Proceedings  of  the  2005  AIAA  Guidance,  Navigation,  and  Control 
Conference,  AIAA  Paper  No.  2005-6434,  Aug  2005. 

12.  Harpold,  J  C.,  and  Graves,  C.A.,  “Shuttle  Entry  Guidance,”  The  Journal  of  Astronuatical 
Sciences,  Vol.  27,  No.  3,  pp.239-268,  Jul-Sep  1979. 

13.  Schierman,  J.D.,  Ward,  D.G.,  Monaco,  J.F.,  and  Hull,  J.R.,  “Reconfigurable  Guidance 
Approach  for  Reusable  Launch  Vehicles,”  Proceedings  of  the  2001  AIAA  Guidance, 
Navigation,  and  Control  Conference,  AIAA  Paper  No.  2001-4429,  Aug  2001. 


26 


14.  Schierman,  J.D.,  Hull,  J.R.,  and  Ward,  D.G.,  “Adaptive  Guidance  with  Trajectory 
Reshaping  for  Reusable  Launch  Vehicles,”  Proceedings  of  the  2002  AIAA  Guidance, 
Navigation,  and  Control  Conference,  AIAA  Paper  No.  2002-4458,  Aug  2002. 

15.  Carson,  J.M.,  Epstein,  M.S.,  MacMynowski,  D.G.,  and  Murray,  R.M.,  “Optimal 
Nonlinear  Guidance  With  Inner-Loop  Feedback  for  Hypersonic  Re-Entry,”  Paper 
submitted  to  American  Control  Conference,  2005. 

16.  Bollino,  K.P.  and  Ross,  I.M.,  “Nonlinear  Feedback  Control  for  Rapid,  On-line  Trajectory 
Optimization  of  Reentry  Vehicles,”  Submitted  to  Proceedings  of  the  2006  AIAA 
Guidance,  Navigation,  and  Control  Conference,  AIAA  Paper  No.  2006-XXXX,  Aug 
2006. 

17.  Ross,  I.M.,  and  Fahroo,  F.,  “Legendre  Pseudospectral  Approximations  of  Optimal 
Control  Problems,”  Lecture  Notes  in  Control  and  Information  Sciences,  Vol.  295, 
Springer- Verlag,  new  York,  pp. 327-342,  2003. 

18.  Ross,  I.M.,  and  Fahroo,  F.,  “Pseudospectral  Knotting  Methods  for  Solving  Optimal 
Control  Problems,”  Journal  of  Guidance,  Control,  and  Dynamics,  Vol.  27,  No.  3,  pp.397- 
405,  2004. 

19.  Ross,  I.M.,  Fahroo,  F.,  and  Gong,  Q.,  “A  Spectral  Algorithm  for  Pseudospectral  Methods 
in  Optimal  Control,”  Proceedings  of  the  6th  IASTED  International  Conference  on 
Intelligent  Systems  and  Control,  Honolulu,  HI,  2004. 

20.  Ross,  I.M.,  and  Fahroo,  F.,  “User’s  Manual  for  DIDO  2002:  A  MATLAB  Application 
Package  for  Dynamic  Optimization,”  NPS  Technical  Report  AA-02-002,  Department  of 
Aeronautics  and  Astronautics,  Naval  Postgraduate  School,  Monterey,  CA,  June  2002. 

21.  Josselyn,  S.  and  Ross,  I.M.,  “Rapid  Verification  Method  for  the  Trajectory  Optimization 
of  Reentry  Vehicles,”  Journal  of  Guidance,  Control,  and  Dynamics,  Vol.26,  No.  3, 
pp.505-508,  2002. 

22.  Fahroo,  F.,  and  Doman,  D.,  “A  Direct  Method  for  Approach  and  Landing  Trajectory 
Reshaping  with  Failure  Effect  Estimation,”  Proceedings  of  the  2004  AIAA  Guidance, 
Navigation,  and  Control  Conference,  AIAA  Paper  No.  2004-4772,  Aug  2004. 

23.  Schierman,  J.D.,  Hull,  J.R.,  Gandhi,  N.,  and  Ward,  D.G.,  “Flight  Test  Results  of  an 
Adaptive  Guidance  System  for  Reusable  Launch  Vehicles,”  Proceedings  of  the  2004 
AIAA  Guidance,  Navigation,  and  Control  Conference,  AIAA  Paper  No.  2004-4771,  Aug 
2004. 

24.  Bolender,  M.A.,  and  Doman,  D.B.,  Nonlinear  Control  Allocation  Using  Piecewise  Linear 
Functions,”  Journal  of  Guidance,  Control,  and  Dynamics,  Vol.27,  No.  6,  pp.  101 7- 1027, 
2004. 

25.  Doman,  D.B.,  and  Oppenheimer,  M.W.,  “Improving  Control  Allocation  Accuracy  for 
Nonlinear  Aircraft  Dynamics,”  Proceedings  of  the  2002  AIAA  Guidance,  Navigation,  and 
Control  Conference,  AIAA  Paper  No.  2005-4667,  Aug  2002. 

26.  Oppenheimer,  M.W.,  and  Doman,  D.B.,  “Methods  for  Compensating  for  Control 
Allocator  and  Actuator  Interactions,”  Proceedings  of  the  2004  AIAA  Guidance, 
Navigation,  and  Control  Conference,  AIAA  Paper  No.  2004-5168,  Aug  2004. 

27.  McLean,  Donald,  Automatic  Flight  Control  Systems,  Prentice  Hall,  Cambridge,  1990. 

28.  Etkin,  Bernard,  Dynamics  of  Atmospheric  Flight,  John  Wiley  &  Sons,  New  York,  1972. 


27 


